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This paper focuses on synthesizing sliding mode control (SMC) for flexible- 
joint manipulators (FJM) based on serial invariant manifolds in order to 
increase the control quality for the system. SMC based on the serial invariant 
manifolds is proposed. The control law is found based on synergetic control 
theory (SCT) and analytical design of aggregated regulators (ADAR) 


method. In order to improve the control quality due to the effect of the 
stiffness value between two links in the system, a mechanism for 
constructing manifolds is built. The time response of the outer loop 
manifolds close to the actuator will be larger in the next round. The control 
quality of the system can be pre-evaluated through the parameters of the 
designed manifolds. Global stability is demonstrated by using the Lyapunov 
function in the design process. Finally, the effectiveness of the proposed 
controller based on SCT is demonstrated by numerical simulation results and 
compared with the traditional SMC. 
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1. INTRODUCTION 

The development and application of technical manipulators led to many studies of manipulator 
control problems. Flexible-joint manipulators (FJM) offer several advantages over rigid-joint manipulators, 
such as light weight, lower cost, smaller actuators, larger workloads, mechanical capabilities, better mobility 
and transport, higher operating speeds, energy efficiency, and a larger number of applications. Therefore, 
they are often operated at high speeds to provide high productivity. However, when the control in the joint 
space operates using only the motor drive feedback, which is the most common case in robotics, the relative 
joint torsion is uncompensated lead to position errors under heavy load and large joint torque [1], [2]. In 
some cases, joint flexibility can lead to instability when neglected in control design, as explained in [3]. Non- 
linearity, model uncertainty, friction, perturbation, and noise effects further complicate model-based 
controller design in controllers of FJM. Therefore, the conflicting requirements between high speed and high 
precision make for a challenging control problem. 

Research on dynamic modeling and control of FJM have received increasing attention in the last 
decades [1]-[22]. Many manipulators incorporate harmonic actuators to reduce speed, and it is known that 
such actuators exert elastic force into the joints. Industrial manipulators generally have elastic elements in the 
drive system, which can lead to the appearance of strong oscillations. For multi-degrees of freedom 
manipulators, joint elasticity can arise from a number of sources, such as elasticity in gears, belts, tendons, 
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bearings, hydraulic lines, and can limit the speed and be obtained dynamic accuracy by designed control 
algorithms and assuming perfect stiffness at the joints. Along with some of the benefits and applications of a 
flexible-joint mechanism, joint elasticity presents a number of control challenges. Nonlinearities, model 
uncertainties, friction, perturbations, and noise effects further complicate model-based controller design in 
flexible-joint controllers [2]. Attempts to address the dynamic challenges of general flexibility have resulted 
in several control strategies being adopted to control these systems. 

Although considerable research has been performed on the dynamics and control of FJM, most of 
the currently available flexible-joint adaptive control strategies reported in the literature are techniques based 
on the model. The control problem of FJM is to design the controller so that the linkage of the manipulator 
can reach the desired position or follow precisely the specified trajectory with minimal vibration to the link. 
To achieve these goals, various methods using different techniques have been proposed as follows: the 
flexible-joint controller model was first proposed in the study [9]. Since then, many control methods have 
been applied to improve the tracking performance of the FJM, such as proportional integral derivative (PID) 
control [6], [7], linear quadratic regulator (LQR). [17], fuzzy logic control [13], [14], sliding mode control 
(SMC) [4], [5], backstepping control [15], robust control [11] and neural network control [5], [6]. For 
example, in [6], the authors designed a PID controller for FJM when considering it similar to rigid-joint 
manipulators and proved its efficiency through simulation results. Agee et al. [7], presented iPI controller to 
improve control quality when the object model is incomplete and has external disturbances, the results are 
proven through simulation and experiment results. But the essence of the PID controller and its variants is 
that the control signal is based on error information. Therefore, regardless of the physical nature of the object, 
it may not give the best control quality to the system. Doina [17], presented the use of LQR controller for this 
system. The results show that the effectiveness of the method is the applicability on embedded systems of the 
LQR controller. But the design of the LQR controller must conduct linearization of the control object, 
leading to the controller not having a good response when the system is far from the working point, and 
determining the matrices in the objective function is also difficult. 

SMC is one of the most powerful and well-regarded control techniques for nonlinear systems 
[3]-[6]. It can be applied to FJM and provides robust control to against disturbances and uncertainty of model 
[3]. The SMC provides the high accuracy and rapid system dynamic response in feedback loops, monitoring 
or tuning modes, as well as robustness to parameter variations and external disturbances [5]. The principle of 
traditional SMC is to limit the system trajectory to a sliding surface and then the system moves on sliding 
surface to the desired point. The selection of the appropriate sliding function represents an important part of 
the SMC design to stabilize the system trajectory. 

In this study, SMC law is designed based on serial invariant manifolds combined with synergetic 
control theory (SCT) [23]-[32]. The first invariant manifold is designed from a state under direct action of 
the actuator, and once the system has fallen into that manifold, the system becomes internally stable. The 
process of determining the internal control signal continues based on variable manifolds, which are intended 
to bring the system to the desired point or trajectory. In SCT, these points and trajectories are called technical 
invariants or control targets. SMC law and the internal control signal are found based on the analytical design 
of aggregated regulators (ADAR) method. The use of manifolds and the ADAR method allows us to tune the 
control quality through the physical nature of the object. In addition, the control law is found to ensure that 
the system is globally asymptotically stable at the first step. The quality of the system response of this 
method is shown by simulation results on MATLAB software and the effectiveness of the method is shown 
by comparison with the traditional SMC. 


2. MATHEMATICAL MODEL OF FJM 

The FJM considered in this paper is shown in Figure 1, where q; is the rotation angle of the link of 
the flexible joint and q2 is the position of the motor shaft rotation angle. The purpose of the controller is to 
generate moment on the shaft. This moment through the flexible joint will act on the link to stabilize or to 
track a given trajectory. The difference of the flexible joint response is determined by the spring's elasticity as 
well as its intrinsic physical properties [4], [8]. The elasticity of the joint is described by the stiffness K of a 
linear torsion spring. Parameters J and J are the link inertia and motor inertia, respectively, and / is the height 
of the center of the link block. The equation of motion for this system is obtained using the Euler-Lagrange 
equation where L is the sum of kinetic energy Kio; and potential energy Po, which are defined as follows: 


Tys 1 
Ktot = 514i +5Jq3 (1) 
1 
Prot = aE = q2)? + mglcos( q) (2) 
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L = Kot + Prot (3) 


Figure 1. Flexible joint manipulator 


Using the Euler-Lagrange equation of motion (4) for the variables q; and q2, we get the dynamic equations of 
the system as (4): 


a (ary a 
ne au (4) 
dt \dqo 


in (4), t represents the torque or control force generated by the actuator. 


1G, + mgl sin(q,) + k(qı — 92) = 0 (5) 
G2 —k(q1 — 92) =T 


Set the state variables as follows: [q, 41 q2 G2]? = [x1 x2 X3 X4]", the equation of the FJM (5) can 
be written as a state space model as (6): 


. r mgl . k 
X1 = X2; x2 = —— Sn (x1) -70a — X3); 


(6) 


. š k T 
X3 = X4; ž4 = 71x) +5 


The control objective is firstly to ensure that the state of the system changes stably to a desired 
operating point and that the static error approaches zero as time approaches infinity. To make it easier to 
write mathematical models in future calculations, we add the following functions: 


ts k 
fil%,%2,X3) = = sin(x1) — ei — x3) (7) 
k 

fa(%1,%2,X3) = 7 =x) 

according to (8) system (7) can be written as: 
xı = %3; Xq = fı (xı, X2, X3); r 
; : 1 
X3 = X4; X4 = fa (%1, X2, X3) +77 (8) 


here the parameters of the model used when simulating the control law are given in Table 1. 


Table 1. The parameter of the FJM 


Symbol Discription Value Unit 
m Mass of link 1.0 kg 
k Stiffness 50 Nm/rad 
J Inertia of motor actuator 1 kg m2 
I Inertia of flexible link 1 kg m2 
g Gravity 9.81 m/s2 
l Length of flexible link 1 m 
m Mass of link 1.0 kg 
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3. CONTROLLER DESIGN 
3.1. Sliding control synthesis method based on invariant manifold sequential set 

When it is not possible to immediately specify a sliding surface of a manifold for the synthesis of 
nonlinear SMCs in SCT, a series or parallel set of invariant manifolds in phase space can be used based on 
the developed scalar and vector synthesis [23], [24]. A descriptive review of the synthesis method of SMC 
based on serial invariant manifolds has been presented in the study [3]. Assume that the initial differential 
equation of the control object has the form (9): 


x; (0) = fi, Xn) + GitiX%i4n G=1n-1 (9) 
Xn(t) = frp Xn) tu 


where x=/x;, ...,XnJ’ is a vector of state variables, dim(x) = nx1; u=u(x) - a scalar control signal, and f,(x), 


..Xn); b= 1,n — 1 is a continuously differentiable function. 

For system (9), the problem of SMC synthesis is posed: it is necessary to define a control law u(x)-a 
function of the state variables of the object (1), ensuring the object transition from an arbitrary initial state (in 
some acceptable area) to a certain state determined by the desired invariant manifolds-the control target. 

In the first step of the synthesis a manifold will be considered. 


Wr = Det Be |xXel + Isal = 0 (10) 


With s4 = Xn — P1 (X1, --,Xn-1) = 0, where p1 (x1, ...,X,—-1) is an unknown continuous function at this step, 
as an internal control for the decomposed system of the next stage: 


Be = fi, ane Xn) + QigiXi4n i=1,n-2 (11) 
*n-1 (t) = fr—1 Hp + Xn-1) + An G1 (X1; + Xn-1) 


based on the objective function of SCT and ADAR method. 
Typ, +p, = 0 (12) 
From the original equations of the object (9), the manifold (10) and (12) find the desired control law. 


u = — (ERZ Be fe (En 1 Xn) + ArsaXess)sign(xx) + Ey) sign(sy) - 


-1 
= Li ge Filey Xn) F Ait1Xit1) — far Xn): (13) 


This control signal moves the system from an arbitrary initial state to a manifold y;=0. Since the 
root yw;=0 of (12) is asymptotically stable when T;>0, this means that the system state falls on the 
submanifold s;, that is, on the sliding surface. The steady motion along s;=0 can be organized using 
submanifolds s2,..., Sm: 


So = Xn-1 — P2(X1; =» Xn-2) = 0; 


(14) 
Sn-1 = X2 — Pn-1(%1) = 0; 
and synthesize intermediate control laws @2,..., Øn-1 on the basis of functional equations of the form: 
TjS§, +5; =0, it=2,n—1; T; >0 (15) 


and the decomposed system has the form (11). 


3.2. Synthesis method of SMC based on serial invariant manifold for FJM 

The purpose of the flexible-joint control is to ensure that the link qı moves in the desired trajectory 
xa by changing the voltage supplied to the motor to create a torque u acting on the motor shaft. From the 
point of view of SCT, it is necessary to synthesize the control signal t(x7, x2, x3, x4 ) - a function that depends 
on the phase coordinates. The control signal will move flexible-links from the initial position following a 
given signal or stabilize at the desired position to ensure the required quality of the system when there are 
effects of disturbances. 
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From the purpose of the control problem, FJM is stable at a given desired position based on SCT, 
the authors propose the first invariant manifold corresponding to the control target. 


xX = X4 (16) 


In the first step, based on the practical and mathematical model of the system, when the control 
signal u changes, it will affect on the dynamics of links q; and link q2. So that the first invariant manifold is 
selected as: 


pı =|s;| =0 (17) 


where sy = x4 — Q1 (X1, X2, X3). The function @,(x,,%2,%3) determines the desired characteristics of the 
changing velocity of qı at the intersection with the invariant manifold p, = 0. The function 4 (x1, X2, X3) is 
determined in the process of synthesizing the control law, proceeding from the invariant condition (14). To 
ensure the manifold (15) is globally stable, according to ADAR [25 ]-[27], the macro variable w, must satisfy 
the roots of the basic (18): 


Tı +y =0 (18) 


where T;>0 ensures the asymptotic stability of the system. Substituting (17) into (18), the control law has the 
form: T, £ 1X4 — P1 (X1 X2, X3)| + |x4 — P1 (X1: X2, X3)| = 0. From the above equation and replacing x, from 


the mathematical model (6), the internal control signal is described as follows: 


ðpı ðxi J A 
T= —k(x — x3) +J > ea T |x4 — Pr (1, X2, X3 )|sign (s1) (19) 


When the system enters the manifold, the performance point of the system touches the intersection of the 
pı = 0 manifold, then the system (6) will be seperated and the dynamics of the closed system are described 
by the (20): 


X41 = X2 
; lL, k 
x2 = -= sin( x1) E 7a — x3) (20) 


Xz = P1 (%1, X2, X3) 


The function @, (x1, X2, X3) in the decomposed system (20) can be considered as an internal control signal. In 
the second step of the synthesis, to find for the control law and to determine the function @, (x1, X2, X3), an 
additional invariant manifold is introduced, which will ensure the stability of the closed-loop system and the 
response of invariant technology (16). A second invariant manifold is chosen: 


W2 = X3 — P2(%1,xX2) = 0 (21) 


To ensure the internal stability of the system (20) similar to the first step, the macro variable w, must satisfy 


the roots of the basic equation: 
Trp. + po = 0 (22) 
where T2>0 ensures the asymptotic stability of the system. Substituting (21) into (22) to get the control law: 
T2 = (x3 = P2(%1:X2)) + (X3 — P2(%1,X2)) = 0 (23) 


From the above equation and replacing x3 from the system of internal dynamic (20), the internal control 
signal @, has the form: 


OQ2 Ox; x3- X4,X 
— 52 992 9x; _ %3~P2(%1,%2) 24 
Pı i=1 9x; at Tp (24) 


When the system enters the manifold, the performance point of the system touches the intersection of the manifold 
wz = 0, then the dynamic system (20) is separated and the closed system are described by (25): 
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X = X3 
T (25) 


mgl . k k 
x2 == —— sin(x) -7% t 7 P2(X1, X2) 
In the third step of the synthesis, to find for the control and to determine the function @(x,, X2), a 


third invariant manifold is constructed, which will ensure the internal stability of the closed-loop system and 
the response of invariant technology (16). 


P3 = x2 — K (x1 — xa) = 0 (26) 
The dynamic system (25) on the manifold in the last step (26) are rewritten as: 
X, = K(x, — xa) (27) 


From the dynamic (27), the asymptotic stability condition at x; = xg is K < 0. To satisfy the condition 
wz = 0, the macro variable Y, must satisfy the solution of (28): 


Tabs + Y =0 (28) 


where 73>0 is the condition for asymptotic stability of the system with the invariant manifold. 
Substitute (26) into (28) to find the internal control signal @2 (x1, X2). 


d 
B gK) + Xp — KX) =0 (29) 


Furthermore, the equations of the decomposed system (25) are substituted into (29), resulting in the resulting 
(30): 


PE k k ; 
T3 (- me sin(x) -7% +7 G2 (x1: X2) — K(x2 — ža)) +x — K(xı — Xa) = 0 (30) 
From (30) the internal control signal @2(x,, x2) is found: 
k 


(ae IK : vi 
@2(X1,X2) = TE sin( xy) + X1 +T (X2 — Xa) — Gy (%2 — KGa — xa)) (31) 


From the (17), (21), (31) and invariant technology (10), the control law u for the FJM has the form. 


0910x; J . 
T= —k(X, = x3) +J Las T, |x4 — P1 (%1, Xz, X3)|sign(s1) (32) 
where p4 = (= cos(x) +1+ =) X2 + wa (=mglsin( x1) — k(x, — x3)) — cee) 


Check the stability of the control law t and the response of the condition for the sliding mode [28]. Choosing 
a positive Lyapunov function of the form: 


V =05 s2 (33) 


When the control law (29) affects on the system (6), the derivative of the Lyapunov function (30) has the form: 


5 . . ð Ox; 1 x 1 
V = 545, = Sy (ži = e) = S17 Xa — 91 (%1,X2,X3)|sign(s1) = -gls <0 (34) 

In (34) and the control law (32) always guarantees the system (6) global stability. In addition, the sliding 

surface S4 = X4 — @1(X1,X2,X3) and its derivative $; can be expressed from the functional (18). Then the 

condition for the appearance of sliding mode (32) is created by the choice of the parameters T;>0. 


3.3. Synthesis of SMC for flexible coupling 
SMC law presented in the studies [3] is synthesized for this system to compare the results of SMC 


law based on serial invariant manifolds. Select the sliding surface of the controller o has the form: 
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o = Vy ae + en (35) 


where n = 4, ai (i = 1,2,3) are positive constants chosen to ensure the dynamics of asymptotic stability of the 
system on the sliding surface, the errors e; are calculated as (36): 


e1 =X, — Xa; 0p = XQ—Xqi €z = Ey = fy (%1, X2, X3) — Ëa; 


Of, af af sis 
e, =e, = ae X + ae fit T X4 — Xq- (36) 
in (35) is written as 
O = Q€] + Q22, + 323 + C4 (37) 


where a; are the coefficients given such that the characteristic polynomial of (35) is a Hurwitz polynomial (all 
roots have negative real part). 


aA1ey + A2e2 + Q323 + e4 = 0 (38) 

Then all roots of the characteristic equation are on the left of the complex plane, so e(t) will 
approach 0 as t approaches œ. The equation o =0 defines a curved surface S in n-dimensional space called the 
sliding surface S. The problem of controlling the output signal x(t) following the setting signal x,(t) is 


transformed into the problem of finding the control signal r(t) such that o —0. 


; : 1 
Selection of Lyapunov function V = so 


Derivative of Lyapunov function V = 00 


To ø 0 it is necessary to choose the control signal z(t) such that V < 0, from expressions (36) and (37). 


CG = 016, + Q262 + A363 + 64 = 4X2 + A2f, +a (Sax 4 oh + n) 
1°1 2°2 3°3 4 1%2 251 XO) xz t ax3°* 
d (af; d (af; d (Of; afa u 
sa a a aa ety) Ha 


Then, the the sliding control law is defined as: 


a a a a a 
4X2 + Unf, + a3 ER + ip + oA x4) + < (4x) + “(#) 


-1 
T=— (54) fr Ox, Ox2 es io dt (40) 
i +2 (54)x +57, Pa) T Uža — AaXq — A3Xa — Xa +TIsat(o) 
where 
ofi azk mol „2h o2 E. 
ax, I cos(x); z = rs = ip (41) 


in (40), the saturation function sat(o) is chosen instead of the sign function sign(o) to reduce chattering which 
can damage the actuator, the parameter T is a positive constant. 


4. RESULTS AND DISCUSSION 
4.1. Description of the intended results 

In-depth simulations have been performed to demonstrate the potential of the proposed control law 
for the FJM system. The proposed control parameters are selected through the parameters T; (i=1:3) and K. 
These parameters reflect the convergence time to the selected manifolds and the total time from initial 
positions to the desired point can be calculated in advance. In this study, a set of parameters will be selected 
with the following values: K=-31; T)=0.2; T2=0.2; T3=0.3. The SMC parameters were selected based on the 
[3] study as follows: [=1040; o1=27; o2=27; a3=9. The implementation of the SMC control law and the 
proposed control law is conducted with two cases: The first case when the initial state of the system 
x(0)=[0.3; 0.5; 0.3; 0.5]" is stable to the origin of coordinates Xtinisn=[0; 0; 0; 0]; the second case when initial 
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states are x(0)=[0.3; 0.5; 0.3; 0.5]" and angle qı is tracking the desired trajectory which has the form x)= 
sin(@t) with frequency o=0.5. The maximum torque generated by the actuator is 10 Nm. 


4.2. Numerical simulation results 

Figures 2(a) and (b) illustrates the angle response q1, q2 of the FJM system with two control laws for 
the first case. Both the basic SMC and the SMC based on invariant manifolds are stable about the origin of 
coordinates. The actual angles of the joints are rapidly approaching the desired values. Besides, it also 
noticed that the quality of the suggested controller is better. The setting time of qı to the error value 0.015 
(rad) is 1.86 s and for the sliding controller normally is 1.92 s. During the rest of the time, the two controllers 
bring the system's state to the origin of coordinates without overshooting. The angle rotation with the ox axis 
of both controllers is very close to the set value. Figure 2(c) shows the moment generated by the proposed 
control law and the normal SMC. The switching phenomenon occurs at time 0.01s, and the moment 
generated by the proposed control law has no switching phenomenon and the torque is smoother. In addition, 
the initial moment of the proposed control law has the opposite direction to the moment that generates the 
normal SMC law, so the overshoot at the beginning of qı, q20f the proposed control law is smaller than of the 
sliding control law shown in the period from 0 s to 3.1 s Figures 2(a) and (b). 


q,(rad.) 


-0.05t- ! i 4 0.05: - i i 
05.05 l if 2 25) 3 38S eS ASS 0 05 1 is 2 Aa a o (‘i CS 


Time (s) Time (s) 


(a) (b) 


t N.m) 


Figure 2. Simulation results when moving with non-zero initial conditions to the coordinate axis (a) response 
of link qı, (b) response of link q2, and (c) moment of motor 


Figure 3 is the response of the FJM system to the above two control laws for the second case. In 
which Figures 3(a) and (b) is the response of link angle qı and tracking error when the following value has a 
period. The proposed control law gives better results: the time response to follow the desired trajectory for 
the proposed control law takes only 2.2 s while SMC takes up to 4.15 s. Besides, the large tracking error of 
the proposed control law is 0.019 (rad) and SMC is 0.14 (rad). In Figure 3(c) the motion of link q2 has a 
smaller amplitude, which means that the link angle q2 moves in a narrower range because the possible control 
of q2 will be increased when the amplitude of the setting value increases. For the moment of the system 
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shown in Figure 3(d), both of control laws generate similar control signals. However, at the beginning time, 
the moment direction of the proposed control law is opposite to that of the SMC control law and the signal 
function is smoother. This can be explained that in the proposed control law, it is only necessary to bring the 
sliding surface in the first manifold, the switching signal is smaller after entering the sliding surface. 
Therefore, the zero point of system will stabilize to the desired point under the effects of dynamics. 


0.35 T T T Į TT 7 f 
= = Tracking error q SMC 


0.3 = Tracking error q -Prop. | 


Tracking error(rad.) 


“0 5 10 15 20 25 30 35 40 45 50 


(b) 


q,(rad.) 


Time (s) 


(c) 


Figure 3. Simulation results when the desired trajectory is sin (0.5t) with non-zero initial conditions 
(a) response of link qi, (b) error of tracking link q;, (c) response of link q2, and (d) moment of motor 


5. CONCLUSION 

The paper has successfully built a SMC law based on serial invariant manifolds and ADAR method. 
According to the numerical analysis of the results, the proposed controller shows the ability to adapt to 
different types of desired trajectories and good tracing ability. Furthermore, the SMC law based on these 
invariant manifolds gives a smooth, non-switching signal and the direction of the control law action ensures a 
lower overshoot than the normal SMC law. 
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